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ABSTRACT 



The present invention provides a method and apparatus for 
modeling interactions that overcomes drawbacks. The 
method of the present invention comprises representing two 
bodies undergoing translations by two swept volimie repre- 
sentations. Interactions such as nearest approach and colli- 
sion can be modeled based on the swept body representa- 
tions. The present invention is more robust and allows faster 
modeling than previous methods. 
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METHOD AND APPARATUS FOR See, e.g., Jackins ct al., "Octrees and their use in rcpreseat- 

MODELING INTERACTIONS ing three-dimensional objects," Computer Graphics and 

Image Processing, (14):249-270, 1980; Meagher, "Geomet- 

This invention was made with Government support "c modeUng using octree encoding." Computer Graphics 

under Contract DE-AC04-94AL85000 awarded by the U.S. 5 and Image Processing. (19): 129-147. 1982. 

Department of Energy. The Government has certain rights in 0«*^er hierarchical structures use various primitives to 

the invention. bound an object or its surface at each level of the hierarchy, 

although sometimes holes are treated e^qplicitly. See, e.g.. 

BACKGROUND OF THE INVENTION Faverion, "Hierarchical object models for eflScient anti- 

™. . I . . c f -II- 10 collision algorithms," Proc. IEEE ICRA 1989, paces 333- 

This invention relates to the field of modeling i° „ j . * • Aon o t i * * • r 

,, J I- • . 340, Scot tsdale, Ariz. 1989. Sucoessnu miplementations tor 

mteractions, specifically modelmg mteractions among com- 1 • . ^ 7. .- -^^^^^^ «*ipivu* » " 

, , . , • ^ exact interference detection and distance computation have 

plex polyhedra m motion. i. u j i . • • ^ u « 

^ , , ... been based on several geometnc pnimtives. Convex-hull 

Many robotics appbc^Uons reqmre modelmg of mterac- implementations, sphere-based techniques, and 

Uons. For e)^mple. coUision detecuon is a basic problem in bounding-prism methods are among those known to be fast, 

robotics and related areas, arising m moUon planmng See, e.g.. Cameron. « Dealing with geometric complexity in 

control, graphical programmmg. mouon-preview. virtual ^^^^^ planning." IEEE ICRA 1996 Workshop on Practical 

^reahty, and dynamical simulation. The collision detecuon ^^^^^ pj^^ Robotics." Mimieapolis. Mimi. 1996; 

problem asks whether a ngid body movmg along a given ^^^^^^ ^^jg^^^, ^^^^ computation between non- 

pathmtersectsj^thany of asetofol^cles a ^^^^^ ^^jects." Proc. 1994 IEEE Int'l Conf on- Robotics 

thatpath InafiiUerversionof theproblem.aU^^^^^^ and Automation, San Diego. Calif. 1994; Sato et al.. "EflS- 

also be determined In both cases, accuracy is of extreme cient collision detection using fast distance calculation algo- 

miportance when the results of coUision detection between ^thms for convex and non^nvex objects," Pioc. 1995 

modeled objects affect the behavior of physical robots or jg^^ Int'l Conf on Robodcs and Automation, pages 772- 

influence the outcomes of physical simulations, such as yj^^ Minneapolis, Mimi. April 1996; Gottschalk et al., 

those used m process and product design and evaluation. «OBB-tree: A hierarchical structure for rapid interference 

Most current metiiods for collision detection rely on detection," Proc ACM SIGGRAPH'90, 1996. However, 

interference detection or distance computation. A few recent none of these results cover swept-body distance or swept- 

algorithms are very fast, using queries at steps in Uie bodies' ij^dy interference detection. 

motion. However, the difficulty of determining collisions or ^anny desCTibed a technique for exact collision detection 

distances between steps mandates the use of very small step ^^^^^ polyhedra moving along path segments linear in 

sizes, consequendy reducmg efficiency. translation and the quaternion representation of S0(3). See 

Interference detection (or collision detection) for a rigid Canny. "Collision detection for moving polyhedra." IEEE 
body R at a position and orientation x and obsUcles O means Trans, on Pattern Analysis and Machine Intelligence, 8(2) 
to determine whether R(x)n O is non-empty, with R(x) 35 :200-209, 1986. Finally. Cameron used space-time tech- 
denoting the image of R in the world. Distance computation niques and develops algorithms and hierarchical structures 
means to determine the minimum distance between all for exact collision detection for non-convex objects. See 
points in R(x) and those in O. Simple collision detection for Cameron, "Collision detection by 4D intersection testing," 
a rigid body R moving over a path segment among obstacles int'l Journal of Robotics Research. 6(3):291-302, June 1990. 
O means to determine whether at any point along the path ^ Both these results are general in allowing exact time inter- 
tiie body contacts or intersects any obstacles. In other words, vals of contact and penetration to be computed directiy. 
if we let C denote the space of positions and orientations and Canny, however, only computes interactions between con- 
let p: [0,1] C denote the path segment, then collision vex objects, Cameron describes a tiieoretical method for 
detection asks whether there is any t e[0,l] such that objects modeled by Boolean constructive solid geometry 
R(p(t)) n 0 is non-empty. 45 (CSG) trees and an implemented method of objects modeled 

Exact or accurate collision detection is often avoided for by Boolean CSG trees with linear half -spaces at their leaves, 

the sake of speed. Usually, either interference detection or The implemented method of Cameron is complicated and 

distance computation queries are applied at closely spaced might be computationally expensive for a large class of 

points on the path. Simple use of interference ctetection can non-convex objects, particularly those whose CSG models 

miss collisions. Growing the objects by a safety margin can 50 include difference operator. Neither Canny nor Cameron 

prevent this, but at the risk of detecting false collisions. With provides computation of the minimal clearance distance 

distance computation, one can vary the step size to reduce between bodies that do not collide, 

the number of queries needed to obtain a given resolution. Current technology thus provides two options, even when 

but resolution is limited by the minimum step size. the motions are linear translations: (i) distance computation 

For a number of years, hierarchical geometric represen- 55 or interference detection between moving objects at discrete 
tations have been used to avoid "all pairs" comparisons in points in time; and (ii) exact collision detection in space- 
interference detection, distance computation, and collision time without clearance distances that has limitations with 
detection. The binary-space partitioning tree (BSPtree) and regard to non-convex objects. The first option often requires 
variants have been successfully used in exact interference very small motion steps for robustness (e.g., to not miss 
checking and contact determination, but they do not readily 60 collisions), which causes a performance penalty in 
yield distance information. Sec, e.g., Fuchs et al.. "On simulations, motion planning, graphical programming, and 
visible surface generation by a priori tree structures," Proc. motion inspection. It is not an option when the motion 
of ACM SIGGRAPH, pages 124-133, 1980. The octree is step-size cannot be arbitrarily controlled, which is the case 
another space-partitioning data-structure that has been used with currently available virtual reality motion-capture sys- 
in interference detection, but it must be used with other 65 tems. Because many objects in the world are non-convex, 
geometric objects to obtain computations matching the the second option is of limited use in the applications 
accuracy of faceted boundary representations or BSP-trees. mentioned above. Furthermore, the lack of robust minimal 
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clearance distance computation during motion limits what is sentations of first usd second bodies and conesponding 
feasible in safety analyses. translations 11. The representations can be firom computer- 
There is therefore a need for a method and apparatus for 'iti^ design (CAD) information, measured parameters from 
modeling interactions between moving bodies that is faster physical devices or models, or computer-picdicted data, for 
and more robust than current approaches. s example. Either or both trandations can be null, i.e., the 

method models interactions between two bodies with either, 

SUMMARY OF THE INVENTION both, or neither undergoing non-oull translation. 

•nie present invention provides a method and apparatus transformed into hier- 

for modeling interactions that overcomes drawbacks of the ^I'lf^f "''?*'°**,!'°°f i^' i*" 

prior approlches. TTie method of the present invention '° smUble for ptoducmg hierarchical bouiiding vo - 

compr^ representing two bodies undergoing translations represenUUons is described by X^v^t m "A Generic 

by two hieralchical swept volume repres^ntatfons. Interac ^"""^ nl^'^^^^'f'^'^.^^^'^i^'"^ °l 
tions such as nearest approach and coLion can be modeled f''* International Conference of 

based on the swept body representations. TTie present inven- „ Rp>»^« »»d Automatw^ inwrpon^^ 

tioniscompuUtSnaUyfastandrobust,andrelativelysimple " Tl^e hieraidiy produced by the method of »,vier,s a bmaxy 

to implement. It can serve as a practical tool in motfon "f^^^^ '"tlf""^ !."°''*''£^''«°" " ""T 
punning. CAD systems, simulation systems, safety analysis. P°!y«>«lro°- The sil,tree txwted at a node lepi^ienls the 

and applications that require modeliig time W inteVac- ^"^^ " "f "^^e of 

tions Xavier's hierarchical geometnc representation contains a 

. ... ..^ conservative approximation, or wrapper, of the object rep- 

A body can be represented m the present invention by a ^^^^^ ^, s„bt«e. One simple varialion is to limit the 

union of convex jwlygons and convex polyhedra Hk body number of vertices on each polyhedron or polygon at interior 

undeigpmg translaUon can then be represented by a swept ^f the bounding volume hierarchic, for example by 

body representauon where the swept body representation replacing polyhedra and polygons in violation of the doUct 

comprises a hierarchical bounding vohime represeotoUon 25 with minimal bounding prisms, 

whose leaves eadi contain a representation of the region „ . ... j • ^ ... . . . 

swept by a section of the body during the translation, wd TT««e skiUed m the art wiH appn=ciate th^the bomidmg 

where the union of the regio.^ is a iiperset of the region ^"'""f. ^'""^J^^"' «^'° body need not be i«x)mpu,ed 

swept by the surface of tte body durii translation. iSer- '^''^ ^« «te body js i«ed as mput for the method of the 

actions between two bodies thus represented can be modeled 30 P«««n' - D""" stiiictures can allow each body to be 

by modeling interactions between the convex hulls of the ""Pf**' «« a dififerem position and locatMn m space for its 

finite sets of discrete points in the swept body represenU- f'*.^* P*"."""'. ^P^y ''^ W'^I^S «he respective mapping 

^j^j^ r ,f r to the vertices in the respective bouDding volume hierarchy. 

'"Svantages and novel features wUl become apparent to f "^j"^. bounding volume hier- 

those skilled in the art upon examination of the following 35 "^hy need only be computed ^ it is needed. The hierar- 

description or may be leiJmed by practice of the invention .'^'^1^'*^' tepresen alion is parUaUy unphcit m 

* J J. * f*u • *• t- 1* J that at each node an actual boundine volume is not 

The objects and advantages of the mvention may be realized . j u . .l . r * j'. vviuiuv » 

and attained by means of the instrumenUUties and combi- i * T whose convex huU « 

nations particularly pointed out in the appended claims. ? " '^"^"f ^"•"""^ computed. At each node of the 

*^ ^ bounding volume representation we apply the motion trans- 

DESCRIPnON OF THE FIGURES formation to the vertices (of the polygon or polyhedron) at 

the node and add the resulting vertices to those at the node; 
The accompanying drawings, which are incorporated into the convex hull of the combined set of vertices is the region 
and form part of the specification, illustrate embodiments of swept out by the node, but we never have to compute this 
the invention and, together with the description, serve to convex hull. 

esqjlain the principles of the invention. Interactions between the two bodies undergoing Iransla- 

FIG. 1 is a flow diagram of a method according to the tions can then be determined from the swept body repre- 
present invention. sentations 14. For example, collisions can be determined. As 

FIG. 2 is a schematic representation of an apparatus another example, the distances between the bodies during 
according to the present invention. so translation can be modeled. The steps involved in determin- 

FIG. 3 is an example of interference determination mg certain of these interactions are presented in more detail 
according to the present invention. below. 

FIG. 4 is an example of interference determination The interaction can then be communicated 15. For 
according to the present invention. ^^^^'"P^^' the mteracUon can be commumcated dirccUy to a 

55 user. As another example, the mteraction can be commum- 
DETAILED DESCRIPTION OF THE ^ated to a software tool for display or design feedback. 

INVENTION Those skilled in the art will appreciate other communication 

modes and functions. 

The present invention provides a method for computing Distance Determination 
the minimum distance between the regions swept by two go A recursive method as in Table 1 can perform basic 
moving bodies that each experience an independent linear distance computation between two modeled bodies (without 
translation. If the two swept volumes interfere (i.e., the sweeps). At each sUge the method considers a pair of nodes, 
minimum distance is zero), the invention provides a method one from each tree, beginning at the roots, with the distance 
for detecting which pairs of primitives used in modeling the dist set at infinity. In the base case, the method simply 
bodies give rise to this interference. ^5 determines the distance between two convex primitives, and 

FIG. 1 is a flow diagram of a method according to the sets dist to this distance if it is smaller than the current value, 
present invention. Hie method begins with input of repre- In the recursive case, if the distance between the bulls of the 
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current nodes is no greater than dist, then the method 
recurses using the curreot node from one tree paired with 
each of the children of the current node firom the other; 
otherwise, it cuts the current branch of the recursion. The len 
(bl)<len (b2) test is a heuristic, comparing princ^al axis 
lengths to decide which one of bl and b2 should be 
descended in the recursive steps. 

TABLE 1 

real CRtkOist^wdy 'R, body •$) 
{ real dist - «; 
pairStack stack; 
body 'bl, •b2; 
6tack.pu8h(R»S); 
while (l8tack.i8£mpty( )) { 

stack.pop (&bl, &b2); 

if (isLeaf(bl) A isLeaf(b2)) 

dist iniii(dis^priinDist(bl,b2)); 
.-uvV..-^ - else if (hulipist(bl,b2)>dist) 
continue; 

else if (isLca£(bl) V (IiiLeafl[b2) v ien(bl)<len(b2))) { 
stack.ptish(bl,b2-K:htldl); 
stack.pu8h(blJb2->K:hild2); 

) 

else { 

stack.pu8h(bl -*childl,b2); 
stack,push(bl -^Iiild2,b2); 

} 

} 

return dist; 



Both hullDist(..) and priniDist(..) determine the distance 
between two convex polyhedra (including convex 
polygons). This can be efficiently done according to the 
method laiown as Gilbert's Algorithm, described by Gilbert 
et al. in **A fast procedure for computing the distance 
between complex objects in three-dimensional space,'* IEEE 
Journal of Robotics and Automation, 4(2), April 1988, 
incorporated herein by reference. 

To extend the method to the case of a translationally- 
swept bodies, note that Gilbert's Algorithm, given two finite 
sets of points, determines a minimum distance vector 
between their convex hulls. Observe that the convex hull of 
the vertices of a polyhedron (polygon) and their images 
under a translation x is equal to the swept buU of that 
polyhedron (polygon) under translation x. Thus, the method 
of the present invention can use Gilbert's Algorithm to 
determine the distance between the volumes swept by two 
polygons or polyhedra under linear translations. It does this 
by adding the new positions of the vertices to the lists of 
input vertices. Finally, if A, B, and C are convex and A U B 
c C, then sweep(A^) U sweep(Bpc) c sweep(C,x), so the 
conservative approximation nature of the hierarchies is 
preserved uixier translational sweeps. 

Accordingly, the method of the present invention modifies 
the method of Table 1 by first adding vectors x and y, which 
gives the translations to be applied to R and S, to the input 
parameter list, it then replaces the function calls primDist 
(bl, b2) and huUDist (bl, b2) with the call transGilbert(bl,x, 
b2, y), which calls Gilbert's Algorithm on the vertices of bl 
unioned with their images under translation x, and on the 
vertices of b2 unioned with their images under translation y. 
The resulting method determines the exact distance between 
the volumes swept by bl and b2 under translations x and y 
respectively. 

As a further description of distance detection according to 
the present invention, consider the pseudocode shown in 
Table 2. This pseudocode takes two sets of vertices as input 
and computes the distance between the convex bulls of two 
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sets of vertices, which is the main work of primDist (..), 
hullDist (..), and transGilbert (..), 

TABLE 2 

real gilDist(vertcx_set vcrts_l, vertex_set vert8_2) 
{ real dist • co; 

simplex md_simplex - uutial_Mtnk^difL_siinplez(veitsl, verts2); 

vector3D<real> di5t»_vcctor, 

npat { 

if (aimpteT _^ti«lly_r!nnbitM(md_^iinple«^ Origto)) 

rcturn(0); 

dtsL-vector •> sinqi!ex_4tstanoe_vectoi(md^_siinplez, OriglD); 
digt > leiigth(di8L-vector); 

if (vcrify_minimai(dist, dist_vectoi; vert8_4, vcrts_2)) 
feturtt(dlistX 

update_Mink ..diff'_Biinplex(di&t_vectoi; &ittd_8iinpiez, 
verts_l, veit8__2); 

} 



The Table 2 pseudocode function gilDist(..) makes use of 

20 a simplex (mdlsimplex) from the Minkowski difference of 
the input sets of vertices verts_l and vcrts_2. Here, a 
simplex is the convex bull of a single vertex, two distinct 
vertices, three non-co-linear vertices, or four non-co-planar 
vertices. This description assumes that a simplex is repre- 

25 scnted by its vertices. The Minkowski difference of two sets 
of points V and W, denoted "MinkDwskiDiff(V; W)" is the 
set of all points p such that there exists some point v in V and 
some point w in W such that p-v-w. The distance between 
two convex hulls is equal to the distance from their 

30 Minkowski difference to the origin, and similariy, a vector is 
the minimal distance vector between two convex hulls if and 
only if it is the minimal distance vector between their 
Minkowski difference and the origin. 
Once initialized, the simplex md_simplex always con- 

35 sists of vertices from MinkowskiDiff(verts_l, verts2). The 
following steps are then repeated until an answer is returned. 
If the current md_simplex overlaps the origin as determined 
by simplex_j5patially_contains(..),then a distance of zero is 
returned. Otherwise, the simplex__distance_vector(..) com- 

40 putes the minimal-distance vector from md_simplex to the 
origin, and a function verify_minimal (..) determines 
whether this vector is also a minimal distance vector 
between the convex hulls of the two input sets of vertices. 
If it is, then its length is retumed as the distance between the 

45 convex hulls. Otherwise, md_jsimplex is updated to a new 
simplex, i.e., one that the function has not considered in the 
current call to it, whose vertices are in MinkowskiDiff 
(verts_l, verts2). Gilbert gives one way of implementing 
simplex distance^vector(..) as the ^'distance sub-algorithm". 

50 Those skilled in the art will appreciate other algebraically 
equivalent embodiments of the present invention. 

If the step of modifying the simplex md_simplex in the 
method of Table 3 results in a simplex that is closer to the 
origin, then the method of Table 2 becomes a hillclimbing 

55 method, which is more efficient than exhaustive search. A 
step for modifying md^mplex that follows the method of 
Gilbert and meets this condition can be implemented as 
shown in the pseudocode of Table 3. This step is particularly 
effective at causing fast convergence and is recommended 

50 for use in the present invention; this is why we call the 
pseudocode function in Table 3 distGil(..). 

TABLE 3 

update_Mink_diflL_simplex(vector3D<real> di8t_vector, 
65 simplex •md__fiimplex» 

verte3i_set vert8_l, vcrtex_set vertx_2); 
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TABLE 3-coatittued 

{ vertex vrtxl, viti2, 8pU__vitx; 

vitEl • iiBX_«uppoit(di«t_vcctor, verta_l); 

vrtx2 - iniiv_«upport(di«t_vcctoi, vcrU__2); ^ 

«plx_vrtx - vrtx2 - vrtxl; 

reiiiove_extntteoiu(diiL-vectoi, ind_f implex); 

ad<L.vertex(ind_jiiinplex, spU^vrtx); 

} 



The pseudocode io Tabic 3 assumes as inputs a vector 
dist_vector, a simplex md_simplcx, and two sets of vertices 
verts_l and verts_2. max_j5upport(..) takes a vector and a 
set of vertices as input and returns a vertex from this set 
furthest in the direction of the vector min_^pport(..) takes 
a vector and a set of vertices as input and returns a vertex 
from this set furthest in the direction opposite the vector. 
^^rempycL^extraneous (..) takes a vector and a simplex and 
removes from the simplex those vertices that are not (tied 
for) furthest in the direction of the vector; if update_Mink_ 
difL-Simplex (..) is "called" as shown in the pseudocode for ^ 
gilDist (..), then the only vertices remaining lie in the plane 
that contains the point on the simplex that is closest to the 
origin and that is perpendicular to the vector from this point 
to the origin. add_vertex(..) simply adds a vertex to a 
simplex. Those skilled in the art will appreciate various 25 
methods for computing min_j5Upport(..) and max__sii|>port 
(..) that exploit different data structures for the input vertex 
set. Going through the input vertex set serially is sufiScient, 
but performance can be improved when all the vertices in the 
input vertex set lie on the convex hull of the set, by storing 30 
ec^e-adjaoency (on the convex hull) information applying 
and hillclimbing instead of a linear search. Hiis latter 
method is asymptotically faster, taking roughly 0(>^ time 
instead of 0(n) time, but has a larger asymptotic constant 
and requires a larger data structure. See e.g., Cameron, 3S 
"Comparison of l\vo Fast Algorithms for Computing the 
Distance between Convex Polyhedra", published on the 
World Wide Web, September 1996. Because the planes 
passing through the origin and perpendicular to the edges of 
a vertex on a convex polyhedron determine the pre-image 40 
poly tope of that vertex under max_support(..) or min_ 
support(")» is possible to apply well-known computational 
geometric methods to yield 0(lg(n)) implementations. This 
method, too has a larger asymptotic constant than the simple 
method and requires a more complex data structure. These 45 
methods can be extended to include the case in which the set 
of input vertices is the union of vertices of a number of 
known convex polyhedra (including polygons), most simply 
by computing the function for each of the convex polyhedra 
and then applying the serial version of the function to the 50 
resulting set of ou^uts. 

Hie test performed by verify„4ninimal(..) merits addi- 
tional description. There are two basic tests using an error 
bound eps based on the minimum accuracy in the machine 
representation of the vertices in the two bodies and applying 55 
standard numerical analysis techniques. First, if dist would 
be smaller than this bound eps, then verify_minimal(..) 
rounds dist to 0 and returns true. Second, vrtxl and vrtx2 are 
computed as in Table 3, and from these two vertices and 
dist_vector we compute an error measure: <disl_vcctor, 60 
disti3 vector>+<dist__vector, vrtxl >-<dist_vector,vrtx2 
>.If this error measure is sufficiently small, then verify_ 
minimal (,.) returns true. Different assumptions yield differ- 
ent smallness criteria. In one simple criterion, this error 
measure is compared to the product of eps and dist. If the 65 
error measure is smaller, then verify_ininimal(..) returns 
true. Finally, if the value of dist is not smaller than its 
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previous value, verify _jninimal(..) returns true, and dist and 
dist_vector can revert to their previous values. 

As a further description of distance determination accord- 
ing to the present invention, consider the pseudocode shown 
in Table 4. Here, we ^neralize the pseudocode from Table 
1 to cover the case when bodies R and S are placed in 
configurations conL_R and conf_S, respectively, and then 
subjected to translations x and y, respectively, where a 
configuration for a rigid body is a particular position and 
orientation. We also show what should be done so that 
distGil(..) can be called directly, instead of using functions 
primDist(..), faullDist(..), and transGilbert(..) as described 
above. 

T\BLE4 

(listaace(body *R, oonfiguiftticni conL-R, vector x, 

body *S, ooafigunUion cooCR, vector y) 
{ real dtit *- oo; 

pairStxck stack; 

body -bl, •b2; 

stack.push(R,S); 

while (IstackasEmptyC )) { 
Btack.pop(Ab^ ftb2); 

vertsl - cooibu»e(bl->boimding_vertioc8(cott£_J<)), 

t2atts!^(bl'>bou]Klmg_veitices(a)iif_R), x)); 
vertsZ * ooinbineCb2->bounding_veitices(ooa]L_S)), 

tianftl^(b2->bouiKliiig_vertux8(oonf_S), y)); 
if (isLeafiCbl) A uUaf(b2)) 

dist «- min(dist, gaOist(veitsl. verts2)X 
else if (gilDist<vertsl, vertsl) > dist) 
oontimie; 

else if CisLeaf(bl) V Oulxaf(b2) V lcn(bl) < Iea(b2))) 
foreacb diOd in b2>>cfaiklRn 
stack.push(bl,ichild); 

else 

foreacb child in bl->cfaildren 
stack.push(ctuld,b2); 

} 

return dist; 



This pseudocode performs a tree traversal similar to that 
in Table 1. However, it assumes that the input bodies R and 
S are aheady bounding volume hierarchies, and that at each 
node of the hierarchy a set of bounding vertices whose 
convex hull bounds the union of the leaves of that node's 
subtree is available. This assumption is made because if the 
method will be used on a body more than once, with that 
body possibly at different configurations, it is disadvanta- 
geous to repeat construction of its bounding volume hierar- 
chy over and over. This pseudocode does not assume that the 
hierarchy trees are binary, so the recursion must cover all the 
children of either the current bl or the current b2. 

If Bp is a pointer to body B (which could be a node in a 
greater body), and conf_B is a configuration, then 
Bp->bounding_vertices(conL_B) returns a set of vertices 
whose convex hull bounds B. Hiis can be implemented by 
simply mapping B's bounding vertices to where they would 
be when B is in configuration conf_B. The particular set 
may have special properties that max_support(..) and min_ 
support(..) can take advantage of, as described above. 
transMap(..) takes a vertex set and a translation and returns 
a copy of the set that has been moved by the translation. 
combine(..) lakes two vertex sets as arguments and com- 
bines them into a set that is the union of the two sets and 
whose particular data structure preserves whatever proper- 
ties that min_support(..) and max_support(..) can take 
advantage of. For example, if the support function can be 
computed in sublinear time individually on the two sets 
because of their data structure, then the data structure output 
by combine should allow the support function to be executed 
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individually on the two sets; the support ftinction can then be 
run on the two outputs. 

If X is a translation, then conibine(Bp->bounding_ 
vertices(conf_B)), lraQsMap(Bp->bounding_vertices 
(oonf_B), x) is a set of bounding vertices for the region 5 
swept by B at starting at configuration conC_B and sub- 
jected to translation x. If B is a convex polygon or a convex 
polyhedron, then its vertices are its bounding vertices and 
the result of this combine is a set of vertices whose convex 
hull is exactly the swept region. Thus, since the distGil(..) lo 
function computes the distance between the convex huUs of 
its input vertex sets, the method of Table 4 implicitly 
transforms the input bodies into hierarchical bounding rep- 
resentations of their swept regions according to the input 
configurations and input translations. is 

Several optimizations can improve the performance of an 
implementation of distance (..) One optimization is to, for 



recursion. Obviously, actually accimaulating a list would be 
optional if we only wanted a count of how many witnesses 
there are. Those knowledgeable in the art will appreciate that 
applicable optimizations described for distance (..) and its 
calling subu^ will not affect the correctness of collision (..) 

TABLES 

tist<pniiL_pair> 

colli8ioos(body *R, oonfigunuion ooa£_Jl, vector x, 
body *S» ooafiguradon oon£_R, vector y, 
real ooUi8ion_di8t, int max^witnesses) 
{ list<prisi_pair> coUisioa..Ji8t(Einpty); 
pairStack stack; 
body -bl. •bZ; 
8t«:k.pu8h(R,S0; 
while (IstackisEmptyC )) { 
stacLpop (Abl^b2); 

veitsl > combiiie (bl->boattdiDg_verttoes(coii(^)), 

tiaitaMap(bl->boiiiKUng_vcrtioef(ooaL-R), x); 
veit82 « ooaibiiie(b2->boasdiiig_vettioes(ooaLJS)), 
traosMap(b2->boaxidiiig_veftioes(ooiiL-SX y); 
if (isLeafifbl) A isLeaf(b2)) { 

if (gilDi8t(verUl, vcita2) <» ooUisioiL-dist) { 

OQllisi(nLjiBtenqueoe(bl» hi); 
if (coUisioi]i_JtstBizc( ) >- inax_witiiesses) 
tetnxn collisioa^list; 



^e'ach^air of bodies used as arguments to distance (..), cache 
the pair of leaf nodes that yields the minimal distance; on the 
next call to the function for this pair, with the bodies 20 
possibly at different configuration, compute the distance 
between these two nodes in their new configurations, and 
then use this distance instead of infinity as the initial value 
of dist. A second optimization is to keep a cut-table of pairs 
of interior nodes for which it is believed that a check against 25 
the current value of dist could cause a cut in the recursion, 
and to do the pre-recursion checks (gilDist (vertsl, verts2) 
>dist) only on the nodes in this table. IWo additional 
optimizations apply to this implementation of distGil (..). 
First, add an optional max_dLst argument, and cut short 30 
, distGil (..)'s computation if the actual distance exceeds this 
distance. When, distance (..) calls distGil (..), this the current 

value of dist (in distance (..)) is used for this argument. 

Second, distance (..), distGil (..), and initial_Mink_diff_ 

simplex (..) are modified so that the bounding vertices that 35 Implementation 

give rise to the minimum -distance simplex foimd by distGil FIG. 2 shows an apparatus A according to the present 
(..) are cached by distance (..) for each pair of bodies (bl, b2) invention. Processor P connects Avith input subsystem IS, 
popped off the recursion stadc staclc, iinplementing a sug- output subsystem OS, and storage subsystem SS. Processor 
gestion in Gilbert. As a matter of practicality, the cache is P can be, for example, a workstation such as those currently 
limited in size so that pairs are bumped from it when it gets 40 commercially available. Input subsystem IS can include, for 
full. example, a keyboard, a mouse, and a network connection. 

Collision Determination Output subsystem OS can include, for example, a video 

The present invention accomplishes collision detection display, an audio speaker, a printer, and a network connec- 
through a modification to the method of distance determi- tion. Storage subsystem SS can include, for example, semi- 
nation. A straightforward way to accomplish collision detec- 45 conductor memory, disk drives, tape storage, and network- 



} 



}} 

else if (gill>tst(vertsl,vert82) > collisioa_(dist) 
contimie; 

else if CwLeaf(bl) V 0»sUaf(b2)v len(bl) < len(b2))) 
foreach child ia b2-x±ildreQ 
staclLpuah(bl/:hild); 

else 

foreach child in bl->childie& 
8tack.push(child,b2); 

} 

return coIIi8ion_Jist; 



tion between two swept bodies is to compute the distance 
between them. If the resulting distance is smaller than a 
user-specified non-negative collision distance ("safety 
margin"), then the two swept bodies are determined to be in 
collision. As an optimization, distance (..) can be modified to 
take such a safety margin as an additional argument; it 
initializes dist to this value instead of infinity. Finally, if the 
two bodies are moving translationally at constant velocities, 
swept-body collision detection can be used to determine 



based storage. 

Apparatus A also comprises means for performing certain 
operations. These means can be programmed in software by 
techniques known to those skilled in the art. They can also 
50 be implemented in hardware, or in combination of hardware 
and software. Apparatus A includes means for using input 
subsystem IS to accept input representations of two bodies 
and corresponding translations Ml. Apparatus A also 
includes means for transforming the input representations 



whether they collide via transformation into a frame in ss into swept body representations M2. Apparatus A also 



which one of the bodies is stationary. 

As a further example, consider the pseudocode in Table 5. 
The function collision (..) is similar to distance (..). Instead 
of returning a distance, it returns a list of leaf node pairs 
whose swept regions are in collision, i.e, a witness list. The 
function takes two additional arguments: a collision distance 
(oollision_dist) and the maximum length of witness list to 
return. In the base case, if bl and b2 are primitives (leaf 
nodes), then we check whether the corresponding swept 



includes means for determining an interaction between the 
swept body representations M3. Apparatus A also includes 
means for using output subsystem OS for communicating 
the interaction M4. 
60 Means for determining an interaction M3 can comprise 
means for determining closest approach or collision from 
volumes swept by nodes in bounding-volume hierarchical 
representations of two bodies. The means for determining an 
interaction can accordingly comprise means for determining 



regions are at most oollision^dist apart; if they are, we add 65 distance between the convex hulls of two sets of vertices, 
them as a pair to the witness list. Also, collision_dist is used The means for determining an interaction can accordingly 
in the conditional instead of dist, as in the test for cutting comprise means for determining distance between the origin 
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and firom the Minkowski difference of two sets of vertices. interference, and (ii) which pairs of polygons interfere 

It can also comprise means for initializing the (vertices of) during the motion. Basic interference detection can only 

a simplex of the Minkowski difference of two sets of answer (i) and (iO to a resolution equal to the step size, 

vertices. It can also comprises means for determining Accuracy is attainable if both the step size and the interfer- 

whether the simplex overlaps the origin. It can also comprise 5 ence threshold (safety margin) can be precisely manipulated, 

means for determining whether a Une segment between a Basic distance algorithms have the advantage of efficient 

simplex and a point is a minimum-length line segment. It step size estimates. Finally, both (i) and (ii) can also be 

could also comprise means for modifying the simplex. reduced to polygon-polygon collision detection problems by 

Example Result and Performance stepping through the motion and collecting alt polygon pairs 

Example of interference determination, implemented as less than a step size apart, 

distance determination subject to maximum and minimum In contrast, a single swept-body interference query is 

thresholds, covered two model scenarios. In the first, shown sufficient to answer (i) exactly. On an implementation that 

in FIG. 3, coded "FT\ a truck chassis (lOK polygons) can automatically collect all pairs of interfering polygons 

moves through an environment containing other truck chas- (i.e., witness pairs), a single query is also sufficient for (ii). 

sis and a teapot (42K polygons total). The objects are up to Because the translational swept-body distance method is 

10 units in scale, and the translational path is 20 units long. exact, it is not necessary to step through the motion. In the 

Zero-distance occurs near both ends of the path, and the gPM scenario, the implementation of the present invention 

^ interference and distance queries are typical of gross-motion required 0.45 seconds each for (0 and (ii) when there was no 

problems or free-flight. contact (e-0.00124), and 0.45 seconds for (i) and 0.89 

In the second scenano. shown m HG. 4, coded «GPM", (1335 ^^^^^ (jq ^hen there was contact 

a gear (3920 polygons) drops through a hole m a flat plate 20 (e^.o0126). For this lest, no cache initialization queries 

(4054 polygons) and onto the spmdle of a motor (2252 ^^^^^ ^ 30rt of query would be 

polygons). The motor is roughly umt scale, and the trans- ^^^^ ^ practice. 

lational path is one unit long. The clearance between the gear Sequential-moUon collision detection queries occur in 
and the motor spindle is 0.00125 units. Except where noted, dynamical simulation and other appUcations. An addiUonal 
an initial caU is always made to the disUnce funcUon to 25 problem that arises is (iii) to determine contact initiation and 
initialize the caches, so that the runs reflect steady-sUle termination points during a timestep. Computing a conser- 
behavior. , . ^ ^ * ^ valivc approximation of (ii) — finding a guaranteed superset 
Hie first series of expenments compared the costs of four j j^at interfere sometime during a step- 
types of queries: basic distance (D), interference detection ^^^^ ^^^^ ^ ^ coUection of polygon-polygon 
(I), swept-body disUnce (DS), and swept-body mterference 30 problems 

detection (IS). For each model scenario, the motion w^ an example of this sub-task, two cases of the gear- 
broken into 25-400 steps. The results are shown m Table 5 piate-motor example were considered, one in which the 
The table shows swept-body interference detection and 0 0^^25 unit clearance is considered interference/collision 
distance compuUtion costing up to 30-50 percent more Ume (£^.ooi28), and one in which it is not. Five experiments 
than their basic counterparts, Swept-body mterference 35 were conducted. Using basic thresholded interference detec 
detection was typically half as expensive as basic distance ^^^^ collection, we set the interference thresh- 
computation. . . . . u u old to half the step size (TW) and to the same value plus e 
An mterestmg observation is that, despite the much (TWc), Swept-body interference detection with witaess col- 
smaller polygon count, the GPM examples were computa- ^^^^^^ ^ ^ ^S^y^j ^ ^y^Q^t (j^^ 
tionally more intensive than the FT examples. Not only were 40 swept-body tests used a hybrid implementation— the 
clearances small m the hole and on the spmdle, but m both swept-body code was triggered when basic code would 
cases, the geometric symmetry meant that there were many witnesses because of die interference threshold. This 
pairs of polygons approxunately the minimal distance accounts for GPM/ISW being faster than GPM/IS, The 
(0.00125) apart. Hiis was a semi-pathological but realisUc swept-body interference detection with the E but without 
occurrence. While the gear moves onto the spmdle m the last 45 collection (ISe) was also performed. 
20-25 percent of the motion, there are typically 500 pairs of 

polygons that are about the same, minimal distance apart, TABLE 6 
and distance calculation slowed to 10-15 Hz. For 
comparison, setting the interference threshold to 0.00128, 

the implementation exploits cached information to detect so 
interference at over 2 kHz in that segment. 



TABLE 5 





num steps 


25 


50 


100 


200 


400 


sceoario 


expt 




time (secoods) 




FT 


D 


1.60 


1.90 


2.20 


2.90 


530 


FT 


1 


0.32 


0.49 


0.83 


1.50 


2.70 


FT 


DS 


1.50 


1.90 


2.50 


3.80 


6.40 


FT 


IS 


0.44 


0.64 


1.10 


2.00 


3.50 


GPM 


D 


2.00 


3.30 


5.90 


10.70 


20.90 


GPM 


I 


0.59 


1.10 


1.70 


3.10 


6.00 


GPM 


DS 


3.10 


5.10 


9,30 


17.30 


31.90 


GPM 


IS 


1.00 


1.60 


2.60 


4.60 


8.60 



55 





Qum steps 


25 


50 


100 


200 


400 


scenario 


expt 




time (seconds) 




GPM 


rw 


3.70 


3.60 


5.70 


9.80 


7.80 


GPM 




3.70 


3.70 


5.80 


9.40 


17.80 


GPM 


isw 


0.83 


1.20 


2.10 


3.50 


7.80 


GPM 


ISc 


0.44 


0.60 


0.84 


1.49 


2.85 


GPM 


ISWc 


1.90 


3.00 


5.10 


8.70 


16.80 



Two important comparisons are evident. First, compare 
GPM/ISW and GPM/ISc against GPM/TW and GPM/TWe 
to consider how useful swept-body interference detection 
60 might be in answering problem (i)---determining whether a 
collision takes place during a motion step. Hie data shows 
the swept-body method to be much faster except when there 
is no interference and the step size is smaller than the 
clearance. To consider efficiency in collecting witnesses for 
Applications 65 accurately answering problems (ii) and (iii), compare GPM/ 

TWo important problems that arise in assembly planning ISW and GPM/ISWe to GPM/TW and GPM/TWe. The 
are to determine: (i) whether a linear translation causes basic code is several times as costly as the swept-body code 
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when the former must collect many polygon pairs that the 
latter safely rules out, and that the two methods cost about 
the same when they find similarly high numbers of collision 
candidates. 

The particular sizes and equipment discussed above are 
cited merely to illustrate particular embodiments of the 
invention. It is contemplated that the use of the invention 
may involve components having different sizes and charac- 
teristics. It is intended that the scope of the invention be 
defined by the claims appended hereto. 

I claim: 

1. A method for using a computer to model interactions 
between a first body experiendog a fiist translation and a 
second body experiencing a second translation, comprising: 

a) receiving into the computer representations of said first 
body, said first translation, said second body, and said 
second translation; 

b) using the computer to transform the representation of 
said first body and the representation of said first 
translation into a first swept representation comprising 
a hierarchical boimding volume representation whose 
leaves eadi contain a representation of the region swept 
by a section of said first body during said first 
translation, wherein the union of said volumes is a 
superset of the region swept by the surface of said first 
body during said first translation; 

c) using the computer to transform the representation of 
said second body and the representation of said second 
translation into a second swept representation compris- 
ing a hierarchical bounding volume representation 
whose leaves each contain a representation of the 
region swept by a section of said second body during 
said second translation, wherein the union of said 
volumes is a superset of the region swept by the surface 
of said second body during said second translation; 

d) using the computer to determine an interaction between 
said first body and said second body; and 

e) communicating the interaction. 

2. A method according to claim 1, wherein the interaction 
determined is the minimum distance between said first body 
and said second body. 

3. A method according to claim 2, wherein the represen- 
tations of said first body and said second body comprise 
unions of convex polygons and convex polyhedra. 

4. A method accotding to claim 3, wherein the step of 
using the computer to determine the minimum distance 
comprises using the computer to determine the minimum 
distance between the convex hull of a first finite set of 
discrete points in said first swept representation and the 
convex hull of a second finite set of discrete points in said 
second representation. 

5. A method according to claim 4, wherein the step of 
using the computer to determine the minimum distance 
comprises using the computer according to Gilbert's Algo- 
rithm using a first set of points in said first swept represen- 
tation and a second set of points in said second representa- 
tion as inputs to Gilbert's Algorithm. 

6. A method according to claim 4, wherein said discrete 
points are represented in a coordinate system having an 
origin, and wherein the step of using the computer to 
determine the minimum distance between the convex hull of 
a first finite set of discrete points and the convex hull of a 
second finite set of discrete points comprises: 

a) initializing the vertices of a simplex using points fiom 
the Minkowski difference set of said first set of points 
and said second set of points; 
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b) determining whether said simplex overlaps said origin; 

c) determining whether a line-segment between said sim- 
plex and said origin has its non-origin vertex on the 
convex hull of said Minkowski difference set and is a 

5 minimum-length line-segment from said hull to the 
origin, and if so, determining the minimum bngth to be 
the length of said line segment; 

d) otherwise, modifying said simplex using vertices from 
said Minkowski difference set and repeating step (b) 

10 through (d). 

7. A method according to claim 4, wherein said discrete 
points are represented in a coordinate system having an 
origin, and wherein the step of using the computer to 
determine the minimum distance between the convex hull of 
a first finite set of discrete points and the convex hull of a 
second finite set of discrete points comprises: 

a) initializing the vertices of a first simplex from the 
Minkowski difietence set of said first set of points and 
said second set of points; - - ' - 

b) determining a current distance vector as a minimum- 
^ length vector fit>m said first simplex to said origin; 

c) if the length of said current distance vector is less than 
a minimum leiigtht then determining said minimum 
distance to be zero; 

d) otherwise, determining an error measure from said 
^ current distance vector, said first set of points, and said 

second set of points, and if said error measure is 
sufficiently small then determining said minimum dis- 
tance to be the length of said current distance vector, 

e) otherwise, if possible, forming a modified simplex from 
30 said first simplex by removing all vertices fitom said 

first simplex that do not lie on the plane perpendicular 
to the current distance vector and passing through a 
point on said first simplex closest to said origin, and by 
adding a closer vertex from the Minkowski difference 
35 set, wherein a closer vertex is a vertex further in the 
direction of said current distance vector, and repeating 
steps (b) through (e) using said modified simplex in 
place of said first simplex; 

f) othenvise, determining said minimum distance to be the 
40 length of the curreiit distance vector. 

8. A method accordiiig to claim 1 wherein the interaction 
determined is collision between said first body and said 
second body. 

9. A method according to claim 8 wherein the first and 
45 second bodies are represented by unions of convex polygons 

and convex polyhedlra. 

10. A method according to claim 9 wherein the step of 
using the computer to determine collision comprises using 
the computer to determine collision between the convex hull 

50 of a first finite set of discrete points in said first swept 
representation and the convex hull of a second finite set of 
discrete points in said second representation. 

11. A method according to claim 10 wherein the step of 
using the computer to determine collision comprises using 

55 the computer according to Gilbert's Algorithm using a first 
set of points in said first swept representation and a second 
set of points in said second representation as inputs to 
Gilbert's Algorithm. 

12. A method according to claim 10, wherein said discrete 
60 points are represented in a coordinate system having an 

origin, and wherein the step of using the computer to 
determine collision between the convex hull of a fiist finite 
set of discrete points and the convex hull of a second finite 
set of discrete points comprises: 
65 a) initializing the vertices of a simplex using points from 

the Minkowski difference set of said first set of points 

and said second set of points; 
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b) determining whether said simplex overlaps said origin, 
and if so, determining that a collision occurs; 

c) determining whether a line-segment between said sim* 
plex and said origin has its non-origin vertex on the 
convex hull of said Minkowski difference set and is a 
minimum-length line-segment from said convex hull to 
said origin, and if so, determining whether the length of 
said line segment is less than a minimum length, and if 
so, determining that a collision occurs; 

d) otherwise, modifying said simplex using vertices from 
said Minkowski difference set and repeating step (b) 
through (d); 

e) otherwise, determining that no collision occurs. 

13. A method according to claim 10, wherein said discrete 
points are represented in a coordinate system having an 
origin, and wherein the step of using the computer to 

wi^ii^mM^idetsmunc collision between the convex hull of a first finite 
set of discrete points and the convex hull of a second finite 
set of discrete points comprises: 

a) initializing the vertices of a first simplex firom the 
Minkowski difference set of said first set of points and 
said second set of points; 

b) determining a current distance vector as a minimum- 
length vector from said first simplex to said origin; 

c) if the length of said current distance vector is less than 
a minimum length, then determining that collision 
occurs; 

d) otherwise, determining an error measure firom said 
current distance vector, said first set of points, and said 
second set of points, and if said error measure is 
sufiSdently small then if the length of said current 
distance vector is less than a minimum length the 
determining that collision occurs, and if the length of 
said current distance vector is not less than a minimum 
length then determining that a collision does not occur; 

e) otherwise, if possible, forming a modified simplex &om 
said first simplex by removing all vertices from said 
first simplex that do xjot lie on the plane perpendicular 
to the current distance vector and passing through a 
point on said first simplex closest to the origin, and by 
adding a closer vertex from the Minkowski difference 
set, wherein a closer vertex is a vertex further in the 
direction of said current distance vector, and repeating 
steps (b) through (d) using said modified simplex in 
place of said first simplex; 

f) otherwise, determining that no collision occurs. 

14. An apparatus for modeling interactions between a first 
body experiencing a first translation and a second body 
e7q>eriencing a second translation, comprising: 

a) a processor; 

b) a storage subsystem; 

c) an input subsystem; 

d) an output subsystem; 

e) means for using said input subsystem to receive into 
said storage subsystem representations of said first 
body, said first translation, said second body, and said 
second translation; 

f) means for transforming said representation of said first 
body and said representation of said first translation 
into a first swept representation comprising a hierar- 
chical boimding volume representation whose leaves 
each contain a representation of the region swept by a 
section of said first body during said first translation, 
wherein the union of said volumes is a superset of the 
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region swept by the surface of said first body during 
said first translation; 

g) means for transforming the representation of said 
second body and said representation of said second 
translation into a second swept representation compris- 
ing a hierarchical bounding volume representation 
whose leaves each contain a representation of the 
region swept by a section of said second body during 
said second translation, wherein the union of said 
volumes is a superset of the region swept by the surface 
of said second body during said second translation; 

h) means for determining an interaction between said first 
body and said second body; and 

i) means for using said output subsystem to communicate 
said interaction. 

15. The apparatus of claim 14, wherein the means for 
determining an interaction comprise means for determining 
the minimum distance between said first swept representa- 
tion and said second swept representation. 

16. The apparatus of claim 15 wherein the means for 
determining the minimum distance comprises means for 
determining the minimum distance between the convex hull 
of a first finite set of discrete points in said first swept 
representation and the convex hull of a second finite set of 
discrete points in said second representation. 

17. The apparatus of claim 16, wherein said discrete 
points are represented in a coordinate system having an 
origin, and wherein the means for determining the minimum 
distance between the convex hull of a first finite set of 
discrete points and the convex hull of a second finite set of 
discrete points comprises: 

a) means for initializing the vertices of a simplex using 
points from the Minkowski difference set of said first 
set of points and said second set of points; 

b) means for determining whether said simplex overlaps 
said origin; 

c) means for determining whether a line-segment between 
said simplex and said origin has its non-origin vertex 
on the convex hull of said Minkowski difference set and 
is a minimum-length line-segment from said convex 
hull to said origin, and if so, determining the minimum 
length to be the length of said line segment; 

d) means for modifying said simplex using vertices from 
said Minkowski difference set and repeating step (b) 
through (d). 

18. The apparatus of claim 16, wherein said discrete 
points are represented in a coordinate system having an 
origin, and wherein the means for determining the minimum 
distance between the convex hull of a first finite set of 
discrete points and the convex hull of a second finite set of 
discrete points comprises: 

a) means for initializing the vertices of a first simplex 
firom the Minkowski difference set of said first set of 
points and said second set of points; 

b) means for determining a current distance vector as a 
minimiun-length vector from said first simplex to said 
origin; 

c) means for determining whether the length of said 
current distance vector is less than a minimum length, 
and if so, then determining said minimum distance to 
be zero; 

d) means for determining an error measure from said 
current distance vector, said first set of points, and said 
second set of points, and if said error measure is 
sufficiently small then determining said minimum dis- 
tance to be the length of said current distance vector; 
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e) means for, if possible, forming a modified simplex from 
said first simplex by removing all vertices from said 
first simplex that do not lie on the plane perpendicular 
to the current distance vector and passing through a 
point on said first simplex closest to said origin, and by 
adding a closer vertex from the Minkowski difference 
set, wherein a closer vertex is a vertex further in the 
direction of said current distance vector, and repeating 
steps (b) through (e) using said modified simplex in 
place of said first simplex; 
Q means for determining said minimum distance to be the 
length of the current distance vector if it is not possible 
to form a modified simplex according to (e). 
19. The apparatus of claim 14, wherein the means for 
determining an interaction comprise means for determining 
collision between said first body and said second body. 

The apparatus of claim 19 wherein the means for 
determining collision comprises means for determining the 
collision between the convex hull of a first finite set of 
discrete points in said first swept representation and the 
convex hull of a second finite set of discrete points in said 
second representation. 

21. The apparatus of claim 20, wherein said discrete 
points are represented in a coordinate system having an 
origin, and wherein the means for determining collision 
between the convex hull of a first finite set of discrete points 
and the convex hull of a second finite set of discrete points 
comprises: 

a) means for initializing the vertices of a simplex using 
points from the Minkowski difference set of said first 
set of points and said second set of points; 

b) means for determining whether said simplex overlaps 
said origin, and if so, determining that a collision 
occurs; 

c) means for determining whether a line-segment between 
said simplex and said origin has its non-origin vertex 
on the convex hull of said Minkowski difference set and 
is a minimum-length line-segment from said convex 
hull to said origin, and if so, determining whether the 
length of said line segment is less than a minimum 
length, and if so, determining that a collision occurs; 
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d) means for, if possible, modifying said simplex using 
vertices from said Minkowski difference set and repeat- 
ing step (b) through (d); 

e) means for determining that no collision occurs if it is 
not possible to modify said simplex according to (d). 

22. The apparatus of claim 20, wherein said discrete 
points are represented in a coordinate system having an 
origin, and wherein the means fr>r determining collision 
between the convex hull of a first finite set of discrete points 
and the convex hull of a second finite set of disoete points 
comprises: 

a) means for initializing the vertices of a fiirst simplex 
from the Minkowski difference set of said first set of 
points and said second set of points; 

b) means for determining a current distance vector as a 
minimum-length vector from said simplex to said ori- 
gin; 

c) means for determining that collision occurs if the 
length of said current distance vector is less than a 
minimum length; 

d) means for determining an error measure from said 
current distance vector, said first set of points, and said 
second set of points, and if said error measure is 
sufSdently small then if the length of said current 
distance vector is less than a minimum length the 
determining that collision occurs, and if the length of 
said current distance vector is not less than a minimum 
length then determining that a collision does not occur; 

e) means for if possible, forming a modified simplex from 
said first simplex by removing all vertices from said 
first simplex that do not lie on the plane perpendicular 
to the current distance vector and passing through a 
point on said first simplex closest to said origin, and by 
adding a closer vertex from the Minkowski difference 
set, wherein a closer vertex is a vertex further in the 
direction of said current distance vector, and repeating 
steps (b) through (d) using said modified simplex in 
place of said fii^ simplex; 

f) means for determining said minimum distance to be the 
length of the current distance vector if it is not possible 
to form a modified simplex according to (e). 
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